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ABSTRACT 






A program was developed to improve the on-line 
measurement capability of the three-dimensional, 
underwater tracking ranges at the Naval Torpedo 
Station, Keyport, Washington^ The program utilizes a 
Kalman filter routine to minimize the effects of 
measurement noise in determining the true target 
position. The gain schedule used by the filter is 
calculated off-line and may be varied b&sed on 
tracking requirements. Listings of both of the 
Fortran programs are included. 

Simulated exercises were run utilizing a variety 
of gain schedules. Results of these simulations will 
assist NTS engineers in the implementation and 
operation of the program using the NTS computer 
facility. Details of the simulation procedure and a 
listing of the track generator program are included. 
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I. 



INTRODUCTION 



The Naval Torpedo Station, Keyport, Washington currently 
operates two three-dimensional underwater tracking ranges 
with the capability of accoust ically tracking torpedoes and 
similar water-borne targets. The computer system in use 
provides a printed record and plotted display of the 
measured track. As with most tracking systems the measured 
data is corrupted by noise. This noise is due to the 
combined effects of environmental factors and the 
measurement instruments. 

These noisy tracks are later analyzed to remove those 
measurements judged to be most inaccurate on the basis of 
total track statistics. Thus, it is only at some later time 
that a smooth representation of the track is available. 

In the near future an updated computer system will be 
brought on-line. The necessity of designing new programs 
provides the opportunity for expanding the real-time 
capability of the system. It is desired that a smoother 
track be available in real-time without the loss of any of 
the measured data. A long range prediction capability and 
the ability to handle various data rates is also desirable. 

The above requirements and the ready access to the noisy 
measurements of target position indicate the applicability 
of a Kalman filter routine to improve the real-time 
capability of the three-dimensional tracking ranges at NTS. 
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II. THEORY 



The development and use of the equations used in the 
Kalman filter have been widely documented. Rather than 
include the derivation here the reader is referred to [1,2] 
or similar works. 



In this presentation the equations used will be listed 
with a brief description of each. The system is assumed to 
be linear and free of deterministic forcinq inputs. 



We characterize the state by the following state 
difference equations 

X (k+ 1) = PHI * X(k) + GAMMA * W (k) 
and noisy measurement equations 

Z (k) = C * X (k) + V (k) 

where 

X (k) is the n- dimensional state vector at time K 
Z(k) is the m-dimensional measurement vector at 

time K 



time 



V (k) is the m-dimensional random noise vector at 



W (k) is the m-dimensional random forcing input at 
time K, and 

PHI and C are constant matrices. 



The estimator equations are given by 

X (k | k) = X (k| k-1) + G (k) *[ Z (k) - C * X (k | k- 1 ) ] 

and 

A A 

X (k | k- 1 ) = PHI * X (k- 1 1 k- 1) , 

where 

/\ 

X(k|k) is the estimate at time K given K 
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measurements 

A 

X(k|k-1) is the estimate at time K given K-1 
measurements, and 

G (k) is the Kalman filter gain at time K. 

The estimator is initialized by setting X(0|-1) equal to 
the mean of the random target entry points. 

The gain (G) and theoretical covariance of error (P) 
equations are given by 

G (k) = P(k|k-1) * c'* [C*P (k | k- 1) *c + R (k) ]~ l 
P (k | k) =[I - G (k) *C]*P (k | k-1) 

P (k+ 1 1 k) = PHI*P (k| k) *PHI T + Q 

where 

R(k) is the covariance of the measurement noise, 
P(k|k) is the theoretical covariance of the 
estimation error, and 

Q is found by 

T 

Q = GAMMA*COV (W) *GAMMA 

where cov(W) is the covariance of the forcing input. In 
this application the measurement noise causes fluctuations 
in the velocity estimate suggesting that there is an 
acceleration input. This "acceleration" is treated as a 
random forcing input. 

GAMMA is given by 

■ 

T 2 /2 

T 



These equations are initialized by setting P(0|-1) equal 
to the variance of the intiial state estimate- 
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III. PROB LEM DEF INITION 



The design and formulation of a new tracking program may 
best be defined in terms of the present system and the 
improvements to be made. Details of the reduction of the 
accoustically measured track into the usable data format of 
XYZ positioning on the ranges are included in [3]. It is 
assumed that all data has been reduced to the three- 
dimensional coordinates for convenient use as track input to 
the program. 

Under the present system, data is received and stored on 
magnetic tape for later smoothing. simultaneously, the 
measured position of the target is printed with other 
pertinent data (time, point count, array number, etc.). Two 
plots are also generated: target position is superimposed on 
a range chart in XY coordinates; and, target depth is 
plotted in XZ coordinates. 

The typical torpedo track will have two modes: search 
and pursuit of its target. The search mode consists of a 
helical track that does not lend itself to linear 
approximation. 3ecause this portion of the track is of 
minor importance to range observers, any inaccuracies caused 
by a linear approximation can be tolerated. The pursuit mode 
will be a constant velocity track which can easily be 
modeled by a linear, time-invariant system. 

The Kalman filter (see Figure 1) provides an accurate 
discrete approximation to the continuous target track. 

The current smoothing techniques (post-run analysis) 



10 




Figure 1 - BLOCK DIAGRAM OF THE DISCRETE KALMAN FILTER 
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remove those points that are the most corrupted by noise. 
This type of routine initially considers all of the measured 
track points. The position at any time is then estimated 
based on all of the measurements. The resultant track is an 
error minimizing curve fitted to the complete measured 
track. The use of the Kalman filter will not affect this 
type of post-run analysis, as all of the measurements are 
retained. The filter will, in real time, provide a smoother 
track through the use of the predictor and weighted (the 
Kalman gain) correction factor. Thus, by using the filter 
we are able to overcome the problem of noisy measurements 
without the loss of data. 

Many of the required computations can be completed 
off-line so as not to jeopardize the timely application of 
the filter to the track data. Because the geometry of the 
tracking range will remain the same, we can utilize 
previously run tracks to develop a reliable set of 
measurement noise statistics. These statistics will then be 
used to compute the Kalman gain schedule, which may then be 
stored for use at the appropriate time. 

Use of a prior i knowledge of the noise statistics allows 
the programmer and user not only to precompute the gain 
schedule but also to test the program via simulation. 
Variations, such as allowances for various degrees of 
maneuverability, may also be compared. We are able to base 
the assumptions of measurement errors on noise criteria 
only, because the assumed location of the array hydrophones 
has been shown to be highly accurate. [4] 

Two general assumptions have been made about the noise 
in the application of the filter. First, it is assumed that 
the measurement noise is random with a mean of zero and has 
a Gaussian distribution. Also, the noise has been taken to 
be independent of the distance between the target and the 
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array sensors. This assumption is made with consideration 
given to the ray path reconstruction routine used. 
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IV. PROGRAM. DESCRIPTI ONS 



A. THE KALMAN FILTER 



The Kalman filter program has been designed to provide 
an improved tracking routine using a minimum of computer 
storage and computation time. The filter routine has the 
capability cf processing a variable data rate limited only 
by the execution time of the routine and the accuracy 
desired (in the discrete approximation) . This data rate is 
selected prior to each run, as is the advance prediction 
feature. 

In addition to the normal one-step-ahead prediction of 
the filter, the user may select a long range predictor prior 
to each track run. This feature will enable observers to 
evaluate qualitatively parameters such as torpedo homing 
capability during the test run. The long range predictor 
simply advances the current filtered position the desired 
number of sample intervals. The current filtered velocity 
estimate is used in this prediction. 

The operation of the filter may adversely be affected by 
large scale measurement errors. Range operations experience 
indicates that measurement errors on the order of 10 3 feet 
are occassionally recorded. One error of this magnitude 
would invalidate the filtered output for many subsequent 
sample intervals. Because of the feedback operation of the 
filter there must be protection against this form of 
catastrophic failure. 
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This protection is provided by establishing limits of 
acceptability about each of the measurements. The range of 
this acceptability "gate" is adjustable and may be set by 
the user prior to each exercise run. (See Appendix B on 
program requirements for a further explanation.) 

Measurements that fall outside the gate are regarded as 
unacceptable; the gain schedule is set to zero for that 
measurement and the filter is advanced based on prior 
estimates. 

The program is liberally documented through the use of 
"comment" cards. These comments will enable any user to 
operate the program with a minimum of supportive 
documentation. It is intended that only a basic knowledge 
of Kalman filtering and Fortran programming are necessary to 
operate the program. Ease of implementation has been given 
a high degree of consideration in the design of the program. 



B. THE GAIN SCHEDULE 



The Kalman gain schedule is calculated using a program 
independent of the filter routine. This separate program 
permits prior off-line computation and storage of the gain 
schedule. For a given tracking run the optimal gain 
schedule may be computed from the matrix inputs to the 
routine. These gains are then stored for use during the 
actual tracking exercise. If the user chooses to alter the 
gain schedule used, the independence of the gain program 
from the filter provides flexibility. 

In operating the filter, any gain schedule (optimal or 
sub-optimal) may be used. For example, a higher gain value 
applied to each measurement would allow for a higher degree 
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of target maneuverability, but would provide less smoothing. 



This program is completely self-supportive; it requires 
no additional subprograms or routines. 



C. TRACK SIMULATOR 



A track simulator program is also included. Its 
inclusion is not necessary to operate the Kalman filter 
routine at NTS. It is included here only to acquaint NTS 
engineers with the simulation technique used in program 
testing and verification. 

The track generator uses a random number generator to 
select a track origin. The track is then advanced from that 
point based on user selected X Y and Z velocities. The 
actual track is then corrupted by noise to provide noisy 
position measurements. 

The actual track and the measured, noisy positions are 
available as program output. 

This program uses the subroutine SNORM, an IEfi-360 
library subroutine. SNORM is a random number generator that 
produces a normal Gaussian distribution. 
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V. 



SIMULATI ON PROCEDUR E 



The Kalman filter program was designed to handle 
efficiently (in terms of computer usage) the tracking 
measurements and to provide the extra features desired by 
NTS range observers. Once completed it was necessary to 
verify accurate operation of the program in an NTS 
range-type environment. One means of verification was to 
model the working environment and to conduct tracking 
exercise simulation using the model. 

Several simplifying assumptions have been made in the 
model. Simplification was made only where it was determined 
that no conflict existed with realistic operational 
parameters. The primary reason for making these changes was 
to increase the readability of the printed and plotted 
output data. 

In the test model, the target track was generated using 
velocity along the range baseline only. Originally the 
track was modeled with principal motion along the range 
baseline (X-axis) and a slight crossing trajectory (Y-axis) . 
By eliminating the Y-component of velocity the magnitude of 
the noise corruption is represented as the full range of the 
absissa on the XI position plot. 

The program was tested using a track that incorporated 
velocity along each of the coordinate axis but analysis of 
the filtered output data showed no change in the performance 
of the filter. 

Various target velocities were used for program 
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. verification. No differences in performance were noted over 
the velocity range from twenty to fifty-five knots. The 
final model employs a target moving at forty knots (a 
displacement of ninety feet between measurements) . 

Two considerations were made in computing the gain 
schedule used in testing. Statistical data obtained from 
previous range tracking exercises was used to initialize the 
gain computations. Additionally the Q matrix was varied to 
test the the degree of manuverability that could be handled 
by the filter. 

No attempt was made to test directly the "gate'* feature 
of the filter. However, measurements greatly corrupted by 
noise were noted in each of the simulations, providing a 
test of the filter's ability to reject highly erroneous 
measurements . 

No attempt has been made to distinguish which particular 
array supplied the data. It was noted in the problem 
definition that input data to the filter was assumed to be 
in three-dimensional range coordinates. It has been assumed 
that current methods of calculating three-dimensional data 
will be retained and will provide measurement input to the 
filter in terms of the range baseline coordinate system. 
Based on this assumption there is no need to determine which 
array supplied the data. 

The primary purpose of the simulation has been to test 
operation of the filter in such a manner that it might be 
implemented at NTS, Keyport with only minor changes. 
Attempts have been made to anticipate and to resolve any 
problems that might arise. 
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VI. SIM ULATION RESULTS 



After the Kalman filter program had been designed and 
checked for Fortran and logic errors, it was necessary to 
test it in an environment similar to that seen in actual 
range operations. Computer modeled simulations provided a 
rapid, lcw-cost method for verifying the accuracy of the 
program. Several tests were run using a variety of 
operational parameters, as explained below. 

Most of the measured data from the NTS ranges is 
received at about 1.3 second intervals. The few remaining 
exercises utilize a data rate one-half the above. These 
data rates establish the absolute limits of any processing 
routine. One of the important aspects of the simulation is 
the cycle time of the filter. 

All of the simulation exercises were conducted using the 
IBM-360 system at the Naval Postgraduate School under a 
time-shared mode. The tests were conducted at various times 
of the day when system user load ranged from moderate to 
heavy. 

The average time of operation of the filter was 1.4240 
hundredt hs-of-a-second. Given this wide margin of 
acceptability, it is assumed that no difficulty will arise 
when the filter is operated on the NTS range computer 
system. 

In the Kalman gain schedule, the steady-state values 
were achieved after seven to twelve sample intervals 
depending on the input values assigned to the Q matrix. The 
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gain schedule shown in Table 1 is based on a target that is 
expected to undergo little or no maneuvers (accelerations of 
less than 3.2 feet/second 2 ). For all measurements after the 
last indicated time the gain values are equal to the last 
value listed. 



TIME 


POSITION 


VELOCITY 




GAIN 


GAIN 


1 


0.990099 


o 

• 

o 


2 


0.994248 


0.754539 


3 


0. 83585 8 


0.398822 


4 


0.725189 


0.284304 


5 


0.669428 


0.252953 


6 


0.649976 


0.248808 


7 


0.646037 


0.249742 


8 


0. 645805 


0. 250140 


9 


0.645766 


0.250005 


10 


0.645621 


0.249853 


1 1 


0.645519 


0.249798 


12 


0.645481 


0.249792 


13 


0.645474 


0.249794 


14 


0.645474 


0.249794 


15 


0.645474 


0.249794 



Table 1 - GAIN SCHEDULE FOR A NON-MANEUVERING TARGET 
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Two other gain schedules were used in the simulation and 
are shown in Tables 2 and 3. These schedules assume target 
accelerations of 10 feet/second 2 and 20 feet/second 2 / 
respectively. Again the last values shown are the 
steady-state values and are to be applied to all subsequent 
measurements. 

A. NO N- MANE OVERIN G TARGET 

When the target is in a non-maneuvering mode the only 
fluctuations from its track will be due to noise. Because 
this noise corruption is undesirable, the gain schedule used 
should provide for maximum smoothing of the target track. 

The gain schedule (Table 1) was calculated assuming that 
the initial position estimate could be determined within 
±100 feet of the actual position. By assuming that the 
variance due to the noise would be approximately three 
feet/second 2 , maximum smoothing with an allowance for slight 
irregular target accelerations was achieved. 

Using these gains with a simulated noisy track, the 
filtered position estimates were statistically compared with 
the measured positions and the known true track. The 
deviation of the filtered track points from the true track 
was approximately one-half that displayed by the measured 
positions. The standard deviation of the filtered track 
estimates about the true track was approximately equal to 
the theoretical value predicted in the calculation of the 
gain schedule. This favorable comparison of experimental 
and theoretical values indicates that proper initial values 
have been used in calculating the Kalman gain schedule. 
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TIME 


POSITION 


VELOCITY 




GAIN 


GAIN 


1 


0. 990099 


0.0 


2 


0. 994273 


0.757905 


3 


0.869084 


0.548191 


4 


0.84301 1 


0.553351 


5 


0.842683 


0.555230 


6 


0.842387 


0. 554583 


7 


0.842279 


0.554577 


8 


0.842276 


0.554587 


9 


0.842275 


0.554585 


10 


0.842275 


0.554585 


1 1 


0. 842275 


0. 554585 



Table 2 - GAIN SCHEDULE FOB A MANEUVERING TARGET 
(APPROXIMATELY 1/3G ACCELERATION) 



TIME 


POSITION 


VELOCITY 




GAIN 


GAIN 


1 


0. 99099 


o 

• 

o 


2 


0.994342 


0. 767076 


3 


0.915940 


0.759631 


4 


0.915308 


0. 765307 


5 


0.914846 


0. 764878 


6 


0.914830 


0.764944 


7 


0.914828 


0.764940 


8 


0.914828 


0.764940 


9 


0.914828 


0.764940 



Table 3 - GAIN SCHEDULE FOR A HIGHLY HANEUVEBING TABGET 
(APPROXIMATELY 2/3G ACCELERATION) 



22 



Portions of the noisy track and filtered track are shown 
in Figure 2. While the noise corruption cannot totally be 
eliminated, the filtered track does provide a truer 
representation of the actual target path. Further 
improvement can be achieved by applying current post-run 
smoothing techniques to this filtered track. 



B. MANEUVERING TARGET 



For tracking exercises run with a target that is known 
to be maneuvering, the gain schedule can be adjusted to 
follow those maneuvers. If, for example, the exercise is to 
be run with a MK 30 simulator programmed for maneuvers 
involving accelerations of less than 10 feet/second 2 , a gain 
schedule as listed in Table 2 would be used. The higher 
gain values needed would reduce the quality of the real-time 
smoothing. 

The degree of smoothing accomplished can be seen in 
Figure 3, a comparison of portions of the tracks obtained 
from raw, measured data and data smoothed using the gains 
derived for a maneuvering target. 

The reduction in the quality of smoothing may be seen in 
Figure 4. These filtered tracks were obtained using the 
maneuvering and non-maneuvering gain schedules. Both tracks 
were obtained from the same set of noisy, measured data. 

Again, the deviation of the filtered track points about 
the true track is less than that displayed by the measured 
positions. Favorable comparison was made between the 
experimental and theoretical values of the error statistics. 
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Figure 2 - COMPARISON OF THE NOISY AND FILTERED TRACK POINTS 

FOR A NON-MANEUVERING TARGET 

The gain schedule used to produce the smoothed track 
above is for a non-maneuvering target. The degree of 
smoothing attained is seen by comparison of the measured 
track points (X) and the filtered track points (curve) . 

The gains listed in Table 1 were used to filter this 
data. This plot represents the maximum smoothing achieved 
in the simulation. The magnitude of the Y-axis fluctuation 
is due to measurement noise only. 
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Figure 3 - COMPARISON OF THE NOISY AND FILTERED TRACK POINTS 

FOR A MANEUVERING TARGET* 

The gain schedule used to produce this smoothed track 
is for a maneuvering target. Again comparison is made 
between the noisy tracK measurements (X) and the filtered 
track points (curve) . 

The gains listed in Table 2 were used to filter this 
data. Again the Y-axis fluctuation is due to measurement 
noise only. 
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MEASUREMENTS 



Figure 4 - COMPARISON OF THE FILTERED TRACKS USING THE 
MANEUVERING AND NON-MANEUVERING GAIN SCHEDULES • 

The plot shown above is a comparison of the difference 
in the degree of smoothing achieved with the gain schedules 
previously used. The non-maneuvering, filtered track from 
Figure 2 is displayed with a (X) , and the maneuvering 
filtered track of Figure 3 is shown by the curve. 
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c. 



HIGHLY- MANEUVERING TARGET 



One additional simulation was run assuming a target 
accelerating up to 20 feet/second 2 . This high acceleration 
might be expected if an attempt was made to follow a torpedo 
through both the search and pursuit phases of its track. 
Allowances for high acceleration substantially increase the 
gain values (Table 3) . 

With these high gains most of the smoothing effect of 
the filter is eliminated. This point is best illustrated in 
Figure 5, a comparison of measured and filtered portions of 
the simulated track. 

Care must be exercised when the gains are adjusted to 
fpllow large maneuvers. If the gate value is set too low, 
the filter will fail to function. In this test it was 
necessary to double the value of the gate limits (±100 feet) 
used in the two previous simulations. (Further explanation 
of the gate feature is included in Appendix B.) 
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Figure 5 - COMPARISON OF THE NOISY AND FILTERED TRACKS FOR A 

HIGHLY MANEDYERING TARGET* 

The gain schedule used to produce the filtered track 
above is for a highly maneuvering target. Almost a total 
lack of smoothing is noted in comparison of the noisy track 
measurements (X) and the filtered track points (curve) . 

The gain schedule listed in Table 3 was used in 
processing this data. The ability to follow large maneuvers 
results in the lack of smoothing seen. 
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VII. CONCLUSIONS AND REC OM MENDATIONS 



The simulations conducted using the Kalman filter 
program indicate that it will provide improved, real-time 
tracking data for operations on the three-dimensional 
underwater ranges at the Naval Torpedo Station, Keyport. 
The filter accomplishes a partial smoothing of the target 
track in real-time as well as providing the long range 
prediction capability desired by NTS range engineers. Both 
of these features will substantially improve the quality of 
service provided to NTS range users. 

Additionally, either the filtered position estimates or 
the actual measurement data may be used in any type of 
smoothing algorithm to obtain the type of post-run analysis 
currently available. The smoothing accomplished by the 
filter will provide a higher quality input to the post-run 
analysis, resulting in a smoother final track than has been 
previously attained. 

With the exception of minor input/output change 
requirements, the gain and filter programs are ready for 
implementation at range computer facilities at NTS. 
Explanation of these changes is included in tne program 
requirements. Appendices A and B. 

Based on the assumption that the search mode of any 
torpedo tracking exercise is insignificant, the optimal 
tracking and smoothing can be accomplished using the gain 
schedule suggested for a non-maneuvering target (Table 1) . 
Before implementation additional testing and comparison may 
be desirable using exercise data obtained under a variety of 
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operating conditions at NTS. 



In the future, additional improvement to the tracking 
system may be accomplished by altering the data input 
format. As stated earlier, the target's measured position 
expressed in the three-dimensional coordinate system of the 
range was used as input to the Kalman filter program. 
Direct application of the time signal to a filter seguence 
has not been considered at this time. This application may 
be considered as a possibility for futher program 
development . 

Several references have been made to the smoothing 
techniques used in current post-run analysis. No attempt 
has been made to apply such methods to the filter output as 
simulated. It is recommended that the filter be applied to 
previously recorded, range-tracking data and the smoothing 
alogrithm then be applied to this filtered output. 
Comparison should then be made between the filtered and 
measured smooth curves. 
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APPENDIX A 



GAIN PROGRAM DESCRIPTION AND REQUIREMENTS 



The Fortran program GAINS was designed to compute a 
Kalman gain schedule based on user selected input matrices. 
The gain and covariance equations listed in Chapter II were 
used in the computations. 

The user must input the following integer variables: 
the dimension of the state vector (N<6) ; the dimension of 
the measurement vector (H<3) ; and, the number of gains to be 
calculated (ITIME<200) . 

/ 

ITIME will normally be set only high enough to insure 
that the steady-state value of the gains is reached. This 
value will usually be less than thirteen. If a permanant 

change is desired, the dimensions of GK and PKK (line 2) 
should be changed to read "GK (6, 3, XXX) 11 and "PKK (6 ,6 ,XXX) " 
where XXX represents the desired value. 

Additional input requirements are the following 
matrices: PHI, the state transition matrix (dimensions 

NxN) ; C, the measurement matrix (MxN) ; R, the variance of 
the measurement noise (MxM) ; PKKM1, the variance of the 
initial state estimate (NxN) ; and, Q, the variance of the 
random forcing input (NxN) . All of these matrices should be 
input in fixed point arithmetic with no single value 
exceeding ten characters. 

As currently written, the program output is limited to 
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two gains (position and velocity) and the associated 
variances and covariance. If additional values are desired, 
it is necessary to change only statements 43 and 45 as noted 
in the program listing. The actual gain calculations are 
performed in SUBROUTINE GAIN. Other subroutines are used to 
perform the necessary algebraic calculations. 

The pregram output will be a gain schedule and 
theoretical covariance matrix of the specified length 
(ITIME) . These values are output to separate files. The 
gain output is used as input to the filter program which is 
currently written to read 13 gain values. 
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APPENDIX B 



KALMAN FILTER PROGRAM DESCRIPTION AND REQUIREMENTS 



This program requires input from three sources. 
Thirteen values of the gain schedule are read via file 
three. The actual target position measurements are input 
via file four. The program is designed to terminate when 
the measurement value of the X position exceeds 10 s feet 
(see line 95) . Several values must be input by range 
observers prior to each run. These values are the initial 
state estimate (six fixed point numbers, each of less than 
eight characters) , the sample interval, long range predictor 
and measurement gate value (each of fixed point numbers with 
up to ten characters each) . 

The long range predictor is scaled in sample intervals, 
NOT units of time, so care must be exercised to obtain the 
desired value. 

The gate value is used to reject measurements that are 
obviously erroneous. This value must be set high enough to 
allow adequate operation of the filter and still perform its 
function. In the non-maneuvering simulation the value was 
set at 50 feet with a standard deviation of ten feet in the 
generated noise. 

As written the program output supplies the predicted, 
measured and filtered position values and filtered velocity 
estimate. Three statements (124,123,130) output these 
values to one file with all X values listed first followed 
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by all Y values and then Z values. 



Upon implementation at NTS, all filtered (position and 
velocity) and measured (position) values may be output by 
rewritting line 124 and the associated FORMAT statement 
(#300, line 134) . If this change is made lines 127 through 
130, inclusive, should be deleted. 

The dimension statement (lines 1,2) should be changed so 
that XKKM1, Z, and XKK will be able to handle the expected 
number of measurements in any given exercise run. At 
present they are set at 200 (approximately four minutes with 
•a sample interval of 1.31072 seconds). 

The program contains additional comments to facilitate 
its use. 
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APPENDIX C 



TRACK SIMULATOR PROGRAM DESCRIPTION AND REQUIREMENTS 



The simulator program requires no input. The random 
number generator (SNORM) used to determine target entry 
point and measurement noise is seeded with two arbitrary 
values included in the program (lines 5,6) . If the seeds 
are changed they must be odd integer values of eight or 
fewer characters.' 

This program generates a 200 point true track (X) and 
adds random noise to each track point to obtain a noisy 
measurement (Z) . The two tracks are output to separate 
files. 

The program contains additional comments to facilitate 
its use. 
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SUBROUTINE GAIN ( PKKMI » PKK » G f R , E 1 1 PHI , C , N , M ,CT , Q ) 



I s - CO O' o c\j ro in >0 I s - 00 O' O -« CM CO >4“ m nO I s - 00 O' O *-h <\J fO >t in O f>- 00 O' O ^ CM rO -T tf*\ vO I s - 00 O' O eg CO 

O' O' O' o O o o o o O O O o —» — i f- 4 •— » r-4 cm eg og rsi c\j c\j cm cm og cm ro ro co ro ro ro ro m ro ro ^ ^ ^ 

oooooooooooooooooooooooooooooooooooooooooooooooo 

(/) CO (/) 00 </) 00 </></)(/) 00 00 00 00 o 0 o 0 00000000</>00 LO 00 00 00 00 OOoOOO 00 OO 00 OO 00 00 OO 00 oo oo OOOO 00 00 00 </><✓)</) <✓) 

-fc-l— 



I — — I— I — » — I— I — »■ 



o 

•* 

SO 

a 

^ t* 

sOvO 

•» •* 

CON o 

o»—» 

►UJ 

•* 

sO — 

►ro 
>0 - 
woo 

»— 4 'W 

xm 

CL CL 
-X 
— uj 
rOH- 



ro— 

«—»sG 
(X ► 

•*s 0 



ro 



meg 

-o. 

J 3 S 

wUJ 

Oh 



m 

CL 

x 

LU 



X rgcL 

► *. CL—* I— CL Q-X 

— X-* •— - XUJ 

>OrO LUO- HO — X LU)— 

► •» H-X^"*Q- •* CNJ •* I— ► 

orn ^ojhss^ciz *x— 

ww 21 - CLOJ **(XX * v — » X ►»— • 

^r -4 - ^si-ssiuza. **zs 

v^CL XXLU ► **1X1— •'^C 

Q.X •* ►HfhZH **HUJ ►X^C 

►UJ— ZZ ►o •* ►XX^X ** 0 . 
— * 1 — h- •«• **ZOrOZ ► ►og ► 
O -Of— X *00. ► X^CXCLQ.X 
— — *0 *XOXX *0. -XX ► 
OOZ **Q- *OLU ►a. ►XUULUX 
w ► ^HScCOI-ZZN ►)— )— * 
'HvOZZUJ ► * ► *.UJCL ► •‘Of 



^Q-OX **Q- *X •* •‘UJQ-^XCL 
*C X ^ CL CJ X rn uj o *-» »— ~ CL a. X 
Q_ LU ^iiJw(-wUJw wwUJ 
1—00 H-Q.^ w 00 f— 

X •ZQQ^QQ QZDQ W 
□ -<UOQUOOCQO<COQ 
^ ro oc a: oc Q UJ x QC Z5 QC a: a: aC a 
C/) ►)— Q. CL <£q£Q.Q.O0O-)— O-CLCX 

X I- -I _J -I _J _l _) _J -J -J -j -) -I -I I- O 
—*0<<<<X<I <1«<<1<<^UJZ 
Q OOOOOOOOOOOOLJQCUJ 
* 



X 








QC 


9* 








LU — 


Q 








*cx 


X 








•• •>* 










-XX 


OO 










-X 








c 0 cQ ro 


X - 


















cl— ro 










UJX •• 










- 


<0 








XX - 


•* •» 








'-—X 


0 --* 








CLX - 


’-a 


ro 


in 


— 


•— • **x 


F-X 








0 — * 


00 •» 


•» — 


•* -5 


•* 


LUrOCQ 


ZQ 


CNJ -5 


•» 


P-H 


Of «» » 


ax-* 


r-A 4 K 


r — 1 t-H 


W 


rO • 


U-HZXO 


• ZX^ 


-XXw 


zx< 


*«p fH 




ro •* 


in •* ••< 


•* -« 


< w 


UJ 0 — tHO 




— *r- 4 «-H | 


HHQ 


LU hXX X 


ZZH II II 


— II il 


— * II 11 


II II 


XX 00 •‘-t- 


•^- 1 -^ 11 


Om“) h 


0*-»~5 || 


— -0 11 


h OZ h hOh 



to l| It II II 

O^hOO^Z^OO^Z^OO^ZOO^Z O 00 O^^-*^C 

oz^oo“)q: i cnjcnj^qc + vT^^ocirunooc oZ -5 

rV LU O'-H ••XOr— ♦— H ►JOfHiH * *»3 OC LU X »“ 4 *— < *•<%] 

33 X w ’ »— ^ mI— — • I — *— iH-Q XXX »— • 

jMu.Q 0 wujLLaa^’djiLua>-iijao^z dm<qu^c 
ooo^oaxQC^QQoac-^QaoQCOQoaiLu oqoo^xq 



o o 

-H O 



eg o 
eg 



m<r 



o 



m 



o 

in 



38 



la r- oo o> o — « (\i ro 'T in >o oq o ^ (N m m so oo o (ni cn >r tn so r- ao (jn o cm m in sC co 

^ ^4" ^ 4* in in in m in in in in in in vO >o vO no 'O >o 'O >o o r*- r- I s - oo ao oo oo co oo ao ao oo 



«-"4 ^ r— H i-^ ^ rH ^ l-H r—H i-^ «“^ rH ^ T“H fH t—H rH fH rH r— H *-^ r*H ^ »^rH H r— “4 i-^ H H fH t-H H i-^ 

OOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOO 
CO 00 CO CO O0 00 00 O0 CO «/) CO O0 CO 00 CO 00 CO 0000 CO 00 CO CO 00 CO 00 00 00 00 CO 00 0000 CO 000000 CO 00 00 <-0 CO 00 (/) 




• f-H 

-» II 



II 











O 














CM 








in 














»— "4 




















— * 










o 












r— “4 


o 








H- 




— * 








H4 


t— 










45 


-5 


-o 






•* 










O 


CO 


•* 


«b 






—4 


O 








o 




-J 


-J 








o 










O 




<— 






w 












h- 


< 


X 






< 




O 






CL 




* 








CO X 




C\J 






UJ 4* 


o— 


O 


o 






4- — 










•CO 


0-1 


N- « 


►— 4 






— 00 


-1 


o 






UJ 


•* 


1— 


h- 






O -5 1 


•* 


I— 






-IO 


— -J 


< 


< 






1— 










• I— 


• -«# 


a: 


QC 






id “5 




O 




— » 




o< 


i 


1 






o z*— •> 


<*— 


o 


-5 


-o 


—a 


Z «NZ- 


— F» 






o **X-H 






•» 


•* 


-JO 


-C2T — 


-"5 


-5 






r-l# 4-4 


ZoO— J 




CL 2 


CL 


•> 


r-HUJ^J^ -; 


Z - 


2 




— CL— •— 


••CD — 


CL - 


X •* 


id 


-j— * 


Q. t — i 


CLX 


-id 


•» 


•» 


Z H-,^X 


J<^ 


^ -J 


«— 


*•*1 


rsl— 2 


-J— X-J'— 






«— 4 


•HM -w 


II • — 


UJ • II — 


.< II II — 


>X II < • 


II -J — 


II < II XUJLU II W 


II 


UJ + II -* II 



^LL)< 3'-U-5“0 || — -0-5 II UJ^X -<-) || -5 II 3Dm | -J 

O'- ZC5 *—-5 .—-5000 + ^ II — -zz —< •*-* ^ ^ 

eg t oo i —5 -co •-iOw.orn-om-5-H— 'cn + ^ n cm< -»- 4a:cMa: 

-COO •^NCD^h' J*-(w -CL«— •*— -Q.<—J II rq<t—i('0 **f0 -*— | — 4* 2! >4" t— • »— ('4 + »— i II 3 II 3 
V II o || 2T'— <t_Jid X—JX W ^^ w H- id iCZZ II O'— Q- CO >-h C d *— QC H- Q 

woa ii au- ii Q-uLLO ii — '-o ii — u-u.aau.<o-o-aua^a n u-~o 11 '-ujujluujz 

xnvrvjn^fsJ VyMQM<<QNXX> H tH JQ>-HCtD<QXOOQ M Q^ hHM QiOXld^^idlu 



<MO 



CM rn 



inoo^ cm co insOsTO 

r-H(\jcocn cn co rqcoco <r 



r-4 (\jm o 

<r 4 4 m 



39 



APPENDIX E 



KALMAN FILTER PROGRAM LISTING 

^ eg cn nJ- in >o oo o *--i (\j ro vn vO r* oo o ^ cnj co in so go o ^ (\j rn in vO oo O' o ^ ro nT in oo 

O O O O O O o o O rH r-i r-H ^ r-1 CM C\J CM CNJ eg CM C\J <NJ <M <\J ro CO (O CO (O fO CO cO rn CO Nf Ni" >t ^ >1* ^ 

OOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOO 

oooooooooooooooooooooooooooooooooooooooooooooooo 



U_LLULU_LLLLU-LLU-LLLLLLLLLLLLLLLLLLlLLLLLLLLLU^UULLtLLLLLLLLLLLLLLLLLLLLLLLLLl-LLLU_LLLLa-LLLLLL 



O 

O 

CM 

•» 

CO 

M 



UJ 

> 

O 

GO 

< 



UJ 

o 

X 

< 



00 
—I 
< 
> 
at : 
UJ 



o 

o 

eg 

•* 

CO 

•* 

V 0 



p-^^egegco 

xxxxx 

oooao 

XX XXX 
cLcLcLCLcL 



uj •— i 

X 

h- CO 



CM • 



O 



X 

o 

x 

CL 



X 

X 

X 



eg 



x 

a 

LLQ 



l l 



w 




UJ LULU UJUJ 


X 


UJ 


•» 


UJ 


X 


X 


X 


X 






M 




i-4 


XX 


«• 


•» 


*• 


a 




# ## # O 


X • 


* 


w 


UJo 


c\J 


M* 


o 


•* 




• 


Oh 




X 


h-< 


w # 


, —p 










«z 


«— * 


X 


-ILU 


X 


X 


X 


o 




— — <■ , -4 1 — lr— 1 r— <«— < 


h- UJ 


—4 


X 


hq: 


X 


X 


X 


o 






H-X 


•>» 


•» 


LL 


X 


X 


X 


eg 




*»r-< •— 1 r-< r-J f— » 


00 UJ 


p4 




UJ 








•» 




r-<r— (COCA — 


ax 


«• 


1-^ 


LUX 


■fr 


# 


* 


o 






0-0 


CM 


•* 


X< 








w 


•» 




00 


w 


P-4 


H 


h- 


h- 


h- 


X 


r4 


►SUX^XXXITI 


o0< 


X 




00 








X 


II 


— CM^XXOOOOO— 


l—LU 


o 


rvi 


00 UJ 


+ 


+ 


+ 



o 

o 

eg 



x~ 

xo 

xo 

CM 

X - 

QfO 

l-H’W 

oox 

XO 

UJX 

ro: 

muj 

o 



- -XXXX+ + + + + x 

^UJp-iO X 

r-ih- II •* ! II — - -* 

hO «•»•>*> *0 

W P*^H r-< eg rO ^ cn • 

P-<Or-*'— « •* •» O 

•* **^-»egcOi-4*— t^Hr - ipm • 

’—wsrs; SSIh 

X -MX xxxxx • 
|| II II xxxxx — 

OOOO^ II II || II II * 

OOOOr-J^r-l in 

^egeng* •* •* •**— — ^ 

•»(— 4 (MCOH^r- lr— 1«— < X 

mingrci^ww •*•*•*•* **x 

w qL cL cL CM coM"inX 

QQOQOOQ^^^ 

<<<<a:xxxxxxx 

UJUUUJUJCXXXXXXXXU- 
CL CL CL CL LU UJ UJ X X X X X >-• 



UJ 

» 

UJ00 

x«-> 

0.0 



+ 



<< 
- X> 
r-l UJ 
CLZ 

o*— • 



I I I I I I 
h- xxxxxx 
z 

«-• eg com- m o 



UJ 

x 

UJ 

CL 



O 

x 

X 

o 

< 

CL 



00 

ro X 



II X 

~ O 



XXX 

^com 




I I I 



XXX 



1- 




X 


< 




o 




o 


X 


a: 




x< 


r—t 


X 


0-0 




0- 


XXXXXX 


00 


•» 


a 


— <egpo 


UJ 


X 


X 


o 






xxxxxx 


< 


HH 


(X 


WWW 


xo 


X 


X 


OUJ 




h- 


xxxxxx 


UJ 


— * 


X 


psjrMM 


IXIh- 


X 




_Jh- 




X 




X 


rvl 


UJ 




1— 


X 


o 


< 


CM 


UJ 


II II II II II II 








II II II 


<UJ 




o 


Oh- 


r4 


X 




h- 


— 


UJ 




1-0 


II 


cO 


Zoo 


•» 






X 


o 


X 




OOQ 




•• 


HH 


CM 


UJ 


xxxxxx 


UJ 


o 


1— 


XXX 




«— * 


o 




II 


a. 




z 


CO 




•* •• ^ 


UJX 




p-4 


oo 


X 


h- 


r-< og co M“ in vO 




•• 


UJ 


— <<MC0 


>UJ 


•* 


w 










UJ 




z 


WWW 


Oh 


vO 


UJ 


-JUJ 


o 


h“ 


r— 4 r-^ p^ p^ p^ p^ 


X 


— p 


M 


xxx 


CQ< 


SP 


h- 


Uh 


CO 


<-J 




1— 


o 


X 


ooo 


<3 


X 


»— t 


U-00 




HH 


xxxxxx 




< 


X 


xxx 




X 


a: 




o 


o 


xxxxxx 


UJ 


uu 


LU 


CL CL CL 


UJUJ 


X 


3 


UJUJ 


a 


UJ 


xxxxxx 


X 


X 


h- 


LU UJUJ 


XX 






XX 




CL 




< 




LU 





oooo o oooo ooo 
40 



o 



uuo ooo 



o 



O' o ^ cnj rn oo O' o c\i rn > 4 * ia so oo o ^ c\i ro ^ la >o oo O' o ^ ro lh co o cnj rn vf un no 

> 4 “ in la in la la la la trun in >o o >o vO >o vo >o o >o r^ r- r- r^- r- I s * r- ^ r^- r- oo oo oo oo oo oo go oo oo oo ^ O' 

OOOOOOOOOOOOOOOOOOOOOOO OOOOOOOOOOOOOOOOOOOOOOOOO 

oooooooooooooooooooooooooooooooooooooooooooooooo 

MHHMMMHMHMMMMhHHHHMMHMMMMMMMMMMMmMMHMMMMmMMMHMMM 

U-U-U.li.U-LLU-U-U-U-U.U.U-U.U-U.U_U-U.U-U-U-U.U-U-U-U-U-U-U-U-U-lLU_lJ-Li.U.li_U-U-U-U-U-U.U-U.U-U- 



I 

X 

-fr 



> 

o 

CO 

< 



o 

eC 



oO 

LLI 

O 

o 

< 

> 

LU 

H 

< 

H 

00 













< 




> 








1 


► ► 


•» ► 


► •> 




H 




0 










►HAJ 


— m>t 


—AO 


— 




«— • ► 


< 








M 


ww 


v^^ww 


N^S^WW 




UJ 


*:<\j 


LU 








w 




► — ^ r—4 


► — »-H f— 4 


► 


X 


►w 


H 










XX 


►H^XX 


0404XX 


m 


H 


m^z 


CO 








■* 




wwv^^: 


wwn^^: 


w 




WS^ 














CCcC^C^C 




cC 


X 


OCX 


H 








0 


xx 


ooxx 


ooxx 


O 


O 


0 - 


< 


— 


— 


— 






cCcC 


cCcC 


cC 




q£— 




H 


r4 




1 


II II 


cCcC || II 


cCcC 11 II 


CC 


O 




00 


1 


* 


| 






LULU 


LUUJ 


LU 


X 


1 1 1 ► 


X 










— 0 




— -*C4 


H-i 




►—4 


► 


► 


► 


~4 / 


iZiZrH- fr * O 


X • 


■»■ w. 


< 


04 


<1- 


O 


1 / 


► ► 


► — 


► ► 


• 


OH 




O 


W 


w 


w 




-4AJO 


— m<ra 


— Aoa 


I—O 


^X 






X 






X 


wwhi^^wvl-^^wwf-^ 


HLU 


^ X ► ► ► 


X 












► ►iZiZ 


► ►N^iZ 


-II 


mS 


- -OvJvJ-sO 


H 


X 


X 


X 


w 




00 UJ 




►— i 








X 


^xxo 


> - ►xxo 


- -XXO 


> tw* 


gq: 


+>C^C^C^C 




■»■ 


# 


# 




► 


r-KM 


»-HCM 




0.0 


AJ 










If 










00 


w^XXX 


X 


H 


H 


H 



X 



< 

2 : 



00 



< 

o 

Q_ 

o 



►LULUIXI^ ^UJ UJlU^^LUUJlU^in 



«-<<< <<< <<< ^ 
^ 1500 + +OOU + + 000 + ^ 

o • • • »t« • # • X 

— I — I ,~*h-h-H~.— l-h-l 

-> 000 ^^ 000 ^^ 000 ^^ 

• • • — — • «•►•*••• — o 
— - — x 04 — — m> 4 “-^— - »A • 

-4 . — ww w — w 0 

f-H * - ► 21 2 ! - - 21 - •* fSh 

w ^ ^ ^ CNJ 04 (\J ^ ro cn m ^ O 

N^WWWN^V^WWWN^S^WWWN^ • 

O Qd cC cC X X a: cC cC X X a: eC cC x — 

—coo ooo ooo *: 

OcCcCcC II || cCcCCC II II cCcCcC II •* 
C>cCcCcC cCcCcC cCcCcC in 

vfLULULU— —LULU LU-—UJ LUUJ '“•w 

moo 00 00 - -</>t/>00 •* -cOOOoO -^c 
w CO CO CO C\J CO CO CO m >4“ CO CO CO A X 

a<<<ww<<<ww<<<ww 

<WWW^^WWW^N^WWW^ 

UJLLLLLLiZ^LLLLLL^^LLLLU-^lL 

^hmhXXhhhXXmhwXm 



00 < 
HUJ 

2:2: 

LU 

>> 

ujoo 

a:*-. 

0.0 



2 < 

LU 

2:0 



<LU 

HO 

OOQ 

luo: 

>LU 

OH 

ao< 

<3 

LUUJ 

XX 



< 

aC 

LU 

Q- 

o 



o 

a. 



ONkHH 
**#* 

+ — ooo 

^2:2:2: 

— -ooo 

vO*— * + + + 

*-**-“* — 

^x - * - 

XO WWW 

II 

►XXX 
-*0 LU 

II II II O •* H 

-w X LU m 

vOLUOOOm O w i- 

whzzznn 200 

^hOQQZH H-. < h -4 

11 h uj o 

X2X>Nu^ X a£ lU 

o a: 

o CL 



> 

00 

00 

o 

► 

Q. 

CO 

00 

o 



I I I I I I 
H 

2 — *»►►►► 

»— » *— *04 m vfiA O 



XXXXxX 



LU II II II II II II 



LU 

X 



o 

O UJ 
X 



t-mim^A'O 



XXXXXX 



►LA 

mm 

Mo 



H iZO 

x *0 

LU C\J 
X w— 
LU M • 
OC -O' 
O -O' 
(/> 

< -O' 
lu —*a' 

X w • 

NH 
H — O 

x o • 

LU O— • 

x m*: 

► ► 

LU >4*-» 

X 

H OM 

< w 

LU LULL 
^ CC-* 

< 



00 



0000 



CNi O f-H 

t-i m m 

ooo ooo 



ooo 



41 



od ^ o ^ <n m nt irk vQ oo o' o ^ cnj cMm>rin 'Or^co^o^cxim 4 * mo 

OOOOOOOOOOOOO^^*-^^^^-^^CMCMCMCM<N<NCMCMcMCMcnmmmrc>C 0 cn 

O O O ^ ^"4 t—i i — 4 ^ ^ •— 4 r -4 ^ i — 4 ^ »—4 ^ 1—4 t —4 r-^ «— 4 t-H ,— ( i— 4 1-^ (—4 ^ i— 4 1 — 4 ^-4 ^ ^ *— 4 

OOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOO 

J-J-J 



U-U-U-U-U-Li.Li.LLa.U-a.LLLLLLLLLi-U-LLU.LLU-LLLLLLULLLU_LLLLLi-U_LI-U-U-LLU.LLLLLLLL 



z 






w 






o 






CL 






X 






o 


XXX 




< 






□c 


^Hmin 




i- 


WWW 






1 — 4 ,— 4 f— > 




uO 


22Z 




i— t 






X 


xxx 




1- 


xxx 




0£ 


t 1 1 




O 






u. 












QC 


•*•*•* 


UJ 


a 


HCMfO 


\— 


CC 


WWW 


< 


CC 


rvIMiNj 


2: 


UJ 




w 




II II II 


H- 


LU 




oo 


X 


— ■> . n— — * 


UJ 


\— 


xxx 








UJ 


UJ 


— «cMrn 


X 


X 


WWW 


h- 


M 


CCCCCC 




X 


ooo 


UJ 


cC 


CC.CC CL 


I- 


UJ 


QLLLCC 


< 


H- 


LUUJLU 


Q 


UJ 




CL 


a 




3 


r M 


'i. t 


M V 



XX 


XX 


XX 






— • 


— • 


•* •• 


•* •* 


•* •» 






X 


X 


-■CM 


rn^ 


invo 






•* 


*» 














vO 


f- 4 ^ 


<— 4 


f- 4 ^ 






w 


W 


2!X 


2:x 


rs 






X 


X 


XX 


XX 


XX 






X 


X 


XX 


‘XX 


— ^xx 


— * 




X 


X 


XX 


xxxx 


xxxx 


X 


X 


•» 


•«* 




•* •* 


»» •* 


*» 


•» 


A 




II II 


II II 


CM CM II II 


m 


rn 


X 


X 




ww 


ww 


w 




•* 


•>* 




cm a: a: — — < 


?r\cLQC ~+ — 


<tcc 


ry*" » •» •» 


m 


in 


xxmoaxxcnaoxxmo 


Q(NJn 3 *<? 


w 


W 


•» •• 


occc - •* 


OCCC •* •* 


CLOCL ^^ ^w 


X 


X 



— (c\joo^c^rrKraa:a:inoa«^: *acxxx 

^^KlUlUw^KUJlUwwHUJOliJ^^^ 

xx xx xx xxx 

xxa**xxo#*xxa# h * 

XX O XXO XXO 

a> a.> a.— > 

. — O0O0 — — — oO<r> — — oOXoOl— I— I— 
IX)mUJo0O0LULULUC/)O0UJUJUJO0 *></3 

hl-HOOl-hl-OOHl-HOinO^ # 4 

<<< <<< <<< 

ooo + +ooo + + ooo + x + ooo 

t • • • • • • • * ^ zzz 

000 ^ 5 ^ 000 ^^ 000 ^ 



.^(M—*-—— * rC| —in O 'O + + + 

— , — • ■ ■ tw 



X 

X 



X 

•* 

CM 

rvl 

•* 

X 

•* 

m 



x 

X 



X 

•* 

rn 

rM 

•* 

X 

•» 

in 



2: s — 

xxx-^xxx^^xxx^o x x — 

» •* **2:2: •* •* -2:2: •* •* **2: *2!XXX XX o 

H^^^^cNicNjcN^^fOrnm^i- x x x — — — 4 

wwwN^v^wwwxx^^^xox^mm 0—0 — oocM'O^-1 

^^(^XX^^^XX^^^X •X^'-'W 0000 CM • • • •* 

000 000 000 — • xxx ^0^0 »ooox 

CCcCCC II II CCCCCC II II CLCCoC II X || XXX r-— I— l-»CM 

CCCCCC (LCCCC CLCCCL •* XXX ^ •* U.LLLLIL w 

ujujuj^^ujujuj— — ujujuj— in— ^ 11 o u o ao rn ooao cm 

www^^www^^wwwv^w^ II II II ^-ICOX— <X-^ wwwww 
UOOOC/) •* **</)l/>l/> •* ►X •* -f w w h-HHI-l- 

COaOCO^<MCOcQaQrn' 4 -CQcOCOinX'OOOOXOOUJOLU <<<<< 
<<<ww<<<ww<<<wXwzzz i-Nj-h-ini-a-X^sis:^ 
www^^www^^www^w^ooo ii »-. MoaixdaiQiQ 

llllllxxllllu-xxi-lllu-Xllx— i_i—j ao^oahooouuz 

H MMXXHHMXXH.MMXHXX>N^OQ 2 Q 2 ^lUULU.U.tU 



CM 

m 



m 

m 



rn 



ooooo 
tno o ooooo 
conT in — tcMon^m 



42 



APPENDIX F 



TRACK SIMULATOR PROGRAM LISTING _ 

— * eg ro >r m nO r- oo o> o eg m m o h- oo a> o -4 eg cn g- m go r— oo a> o •-» eg ch < 4 - in go r*- ao o -h cm cn <r m 
O o O O O o o o O ^ ^ ^ ^ ^ ^ eg (\j rg rg eg cm cm og rg cn ro to m ro co ro m m cn m ^ *4“ nT 

OOO OOOOOOOOOOOOOOOOOOOOOO oooooooooooooooooooo 

OOOOOOOOCOOOOOOOOOOOOOOOOOOOOOOCOOOOOOOOOOOOO 

OOoOOOoOOOOOoOoOOOOOOOOOOOOOoOoOOOoOOOOOoOOOOOoQOOOOCOOOOOOOOO^OOOOoOOOoOOOOOOOOOl'JOOOOOO 


























UJ 


























oo 


























< 














00 












3 














h- 


























X 












cC 














UJ 












O 














X 












LL 














UJ 


























QC 












oo 














3 












UJ 














00 












3 














< 












►— 1 














UJ 












LL 














2. 






































1— 














O 












X 










o 




K 












UJ 










m 
















QC 










•k 




UJ 












UJ 




CO 






o 




00 












LL 




w 


2 




W 




H- 1 












LL 




> 


00 








O 












—i 




•• 


Q 




X 




X 












a 




— 


UJ 




o 




















cO 


UJ 








a 












o 




w 


CO 




X 




o 








2 




i— 




h- 


• 




o 




< 




00 




00 






— — 


3 






o 


r-H *“4 






h- 




1— 




3 


XX 


O 


X 




X 


•* *> 


a 




o 




X 




3 


•• *k 


•* 


0C 




< 


• • • •in co 


X 




X 




UJ 


• • • 


CL 


mco 




o 




a: 


o ooo^- 


< 




X 




X 


OOO 


h- 


«w^k^ 


o 


2 






O ^^^Xrsl 










UJ 




3 


xeg 


o 


CO 




00 


~-k •« •* 


x 




o 




QC 




O 


*> •» 


rg 






»— * 


* * * 


o 




g- 




3 


* * # 




— — 


*• 


3 








< 






• 


00 




UJ 


XX 


CO 


< 




1— 




oC 






o 


< 


— — 


0C 


•k *k 




t— ♦ 




X 


• • • ^cgrocoeg 


h- 




i— 


o 


UJ 


3ogrq 


< 


cncg 




V— 






— OOO —'WWW 






< 




X 


WWW 




w w 


•» 


M 




o 


comm in »>xn 


LL 






+ 


• 


->» 


00 


Xeg 




X 




CL 


». — «k •■* •• 


o 




> 






ro 


X 


•k «• 


o 


H- i 






h-# •* -* m+ + + 






3 


— — — 


X 


*• 4* + + 


o 


— — 


o 






> 


o •* 


OC 




X 




►— * 


> 


< 


XX 


CNJ 


UJ 




aC 


o •>—"•— *• •• 


UJ 




o 


1 1 1 


< 


»— — — 


QC 


•k «k 


•» 


X 




h- 


•— gegco 


o 






ZZ2 


h- 


>2ZZ 


h- 


<■■4 ^k 


vO 


h- 




x 


• •. ^WW 


X 


o 


> 


•k •* •» 


C0 


M • Ik O 




wweg 


«w 






UJ 


MHl-l-M^fOlAXN 


t— 4 


o 


h- 


*— 1 ro m 


O 


w^rOin 


> 


xeg • 


x 


UJ 






w333^www — 


< 




M 


k^^W 




WWW 


00 


— o 




oc 




CC 


XOOOXXXXOO 


X 


•k 


o 


xxx 


O 


txxx 


— *LU 


00-4 


X 


< 


<*0 


UJ 


cn oc c\irg 


UJ 


eg 


o 




1— 


a: 


Ooo 


egeg3 


u 




a\>4- 


I— 


o n ii ii a it nil * - 


aC 


ii 


-J 


II II II 




a ii it ii 


X3 


•» *-G0 


HH 


> 


<r*-4 


< 


X X -KM 




X 


UJ 




UJ 


X 




-l(N|w 


oo 


M 


vOH 


3 




UJ 




> 


— — 


00 


00—— — 


Ooc 


wwf— 


X 




ego 




JrW ^-lr-l^-<UJUJ 


h— 


o 




Z22 


H- 1 


X2Z 


XUJ 


UJUJ< 


LL) 


a 




UJ 


3 ► •* **3 •* *“h"“ h— 


< 


3 


X 


•k *k «k 


a 


3 * •* - 


<h- 


l-h-XCL 


X 


x 


II II 


X 


o — * co m o r-i cnj ro •—— » 


cC 






— <rom 


X 


33(\jrcy 


< 


hmq^QQ 


t— < 


<3. 


X^> 


3 


,<w^wq:q: 


UJ 


O 


UJ 


WWW 




www 


33 


OCQCOH-X 


o 






oO 


OXXXOMNN22 


X 


o 


h- 


xxx 


a 


<3 eg eg eg 


3 


33300 UJ 




X 




00 




UJ 




O 




a 




aCLL 










<1 




o 




X 




< 




h-CJ 





oo 

i-H rg 

OOO OOO OOO OOO OOO OOOO 

43 



LIST OF REFERENCES 



1. Gelb, Arthur, Applied O ptimal Estimat i on , p. 102-142, 
fl.I.T. Press, 1974. 

2. Kirk, Donald E., EE4414 Class Notes (unpublished). 

Naval Postgraduate School, 1975. 

3. NAVORD OD 41114, Data Reduction Re quirements, 3-D D ata . 
15 February 1973. 

4. NAVAL TORPEDO STATION REPORT 1 04 9 .Validity of the 
Centerline C oordinate Syste m at t he Nano ose Range , by 
J. F. Ebert, 10 December 1969. 

5. NAVORD OD 41115, Description and Operation, 3-D Range 
Equipme nt , 15 February 1973. 



44 



INITIAL DISTRIBUTION LIST 



No. Copies 

1. Defense Documentation Center 2 

Camden Station 

Arlington, Virginia 22314 

2. Library (Code 0212) 2 

Naval Postgraduate School 

Monterey, California 93940 

3. Department Chairman, Code 62 2 

Department of Electrical Engineering 

Naval Postgraduate School 
Monterey, California 93940 

4. Professor Harold A. Titus, Code 62Ts l0 

Department of Electrical Engineering 

Naval Postgraduate School 
Monterey, California 93940 

5. Commanding Officer 2 

Naval Torpedo Station 

Keyport, Washington 98345 

6. Lt. Eric James Benson, USN 2 

735 Huntington Court 

Martinez, California 94553 



45 



% 




Thesis 

B3915 

c.l 




Benson 

An application of 
Kalman fi Itering to 
underwater tracking. 



393 



( 



10 JUN 82 
.20 JUS- 82 

fcpTf? 

15 f FB 89 
21 KiT 90 



S 1 2 3 6 6 
25787^ 

1 

35521 " 

3 5 3 0 ii t, 



Thesis 

B3915 

c.l 



160893 



Benson 

An appl i cat ion of 
Kalman filtering to 
underwater tracking. 



